Iterative Closest Point For 2D Curves With Opencv